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(54) CONTROL DEVICE FOR LEG TYPE MOVING ROBOT 

(5 7) Abstract: 

PROBLEM TO BE SOLVED: To provide a control device 
for a leg type moving robot in a condition likely tumbling, 
so as to reduce as small as possible damage received by 
the robot by its tumbling and damage of a mate side 
object against which the robot collides when it is 
tumbled. 

SOLUTION: By an abnormality processing device 13 
provided in a robot R, whether the robot R is placed in a 
condition likely tumbling or not is judged one after 
another, when a condition likely tumbling is judged, by a 
robot leg control, device, so as to lower down the center 
of gravity of the robot R (waist down) by a robot leg 
control device 1 1, an actuator 5 of a movable leg 3 is 
controlled. The condition likely tumbling is judged by 
whether a residual capacity of a battery 1 5 is decreased 
or not. In the case of lowering down the center of 
gravity of the robot R, regenerative generation power 
generated in the actuator 5 (electric motor) is returned 
to a side of the battery 1 5. 
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Hm-fZo &ft* &&=>>7 : 7^T>*mtt&:7£&3 2 

mCo^tt, buIS#^^9-3 3 1 7 

«HEB«^RR^at/B«l#J£5F*R*tt. ±.E« 

•-frUtt. B*4«RA^B«#*T*K**Br«i-* 

[0 0 6 1 ] ^^^^^^81^3 314, #m±OM 
3 0^^^5ttCB«J:^«/^f»«UK^rtS« 
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^lELTft 5^iEB *J£^ffiK/S5»|fcit -5 M«P 

SWIM ^^tcMI£Wr^^*ai-^5cog«2Effi 
(»L< liWT*^~^-* 5 ^Mt5#^-^ 
1 8 5 

[0 0 6 2] m$L=*> hn-734(l BWEJWT^fa 
*«»^e—^ l 8<fc*lHHE*!> **-*"r--f **** 

^33 -e** <btiti BttSffiiciittS-tirs <fc 3 dittifST 

[0 0 6 3] KJb»WLfcJ:5fta*y hPMWSIfiKl 

tt»8S** B *«tt«F»K«7c S *S fc*<&1iflte«K 
* > hMdmdx, MdmdySr B**«cKA>t> 'fr/NUB 9 
lc£if l#><5J:3I^ S^=>y7-7^ry^iM^ 
3 2»cJ:ore«JB¥ffi«/5S*«Lil^aa:*lE*tt« 

B»& B#ttK:Safefb£*5 J: 3 teBfWS £ <h £ ft 

So 

[0 0 6 4] ffi, Mian #5/ hRffimSBl 2«, Mx. 

ft) &*£-fS 0 IT, ^^LfcSMfif:, 99 
!Sj&T:^^-^ffi«ffi2Sl 7 let tfetb^ix^J^ 

8*«/«-r<5#«»^-^ 1 9 0XB6fl) 

7"2 l«r^LTlHT^^3.^-^84r7^ — K^<2/^#J 

[0 0 6 5] **tt?g»fci3v>r. lHE»#y 

hUPMflPSB l l <o#s££j*83 0 as£/8-f5 B£?il®J 

[0 0 6 6] *S±J8S3 0ri>\ «*tfo3(Ky FR^il 

»«jft^» (mm \zm\.T4ij&-fznmmms<*-> 

*nUmBU7'<f- % Sti* «B1»W9-3 3l'7 6* • 

*>*^tt«MHF8- 2 1 4 2 6 i*fcr*siffiKA^» 

m x. tf&fttif<n b mmwi'< ^-vil B5fc*+J: 
3ft'** — B5lt DTK^hRco^ff 



6) d*-t^J£T«7©««»-ei»*«:BII»Lfc*tli (0 
5 0t±»OB) »^MP3a«*HiLt, 
ffi*Oig«i«<^ fT»«i 3 (:: -CfiMMRW* 3 b SrWi- 

^r®jfl* 3 b ojs^Ptt 7 £^o*ffla>&#*£-&**-c 
* - > &mj£Mtz& L t <a -e 2> -5 , 

[0 0 6 7] **16«1»-C?f±. $Mfi£S3 0 

'«x.l^B6 3trfH7(c^i-i 3ftB«5I» 

[0 0 6 8] -fftfc>*>> B6f±, Wttfta^y hR^ig 
#»ft#fTifc*-e (B 6 ^S-hl9:0[a) , <E«*JWf^a 
2 7 36»6^ i maj^7*s-**bixfc»*lc#S±rii»3 

UrBoH. HI£B?>B, SlIOTISiB (*TS) <£>HJ 
icJiHic^i-i 3 f-, iBIM^ «TIMV 3 b <nmm - mfc* 
ff^oopiKy bRtm&fr&tbT&vtfy hR<D±1£ 

#*£jS*3 0tt, l«5Hft^^-^ic**ix-58»eB 
[0 0 6 9] tLtt. H7li, Wx-tfospy hR^S^rflC 

o ^^^-f s § mmmy< * — v \z m^-r z>\><d 
[0070] $ e>i-. mess9&£«ft:fti»8t*ft 3 6 ^ 

g:£ii-r6 IffiaMflt^R*^— > hMdmdx, MdmdylC 
mKMeMftm*» 2 7 ©WW«3l»c:ov^1iJS L 
r^< 0 

[0 0 7 1 ] WiS<!0ii »9 , ffifc±m&tl*:-* > NMdiD 
dx, Mdmdyttojjfy h R<a±ft^«#g&#£ BW«# 

6Atfls»*i LTf*anW«ccz#y KRlCflg^bf^fflS 
^5-<#^S^ (^e->>h) -e*>*?. flfBsKyhR© 

¥»7©*R(Ott«/»^»*»K:tt % ±E«flt±« 
&Jj^r—* > hMdrndx, Mdmdy^BW^flcS/J^i^ia 
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fcatfy hRSra«0flJcMi"i: 5*«— * > h (=Mdm 
dy) #3=C<5) o 

[0 0.7 2] Ld>6lc, MK^tcS^^—^VhMdmd 
x, MdBidyd*iS*"C*>*£* J£^» 7 <B»*&tt£«Rl. 
oo x lffl|^*S^^~^ > hMdndx, Mdmdy££ifL 

[0 0 7 3] ttC«WIR¥S2 7»: 1 Aft 

&<D «fc 5 fcHMNfefleK**— > hMdmdx, Mdmdyi*Bf 
SISriBx.^*^ (£ DI£L< tt, Mdmdx^iiMdmdyiS 

[0 0 7 4] f ftfcfc, WW3E#JH-m. »«^*K* 
^•—^ V hiMdmdx, Mdmdy&tt&$)±$ < T WJ£¥ 
*7©ffi«/»f&^«]EK:J:o-c, BHMte*RA*- 
^ > MVfdmdx, Mdmdy£ 9 ic^if 

— > > hMdmdx, Mdmdy£ %W;l£MK?)^ foMM 9 t££ 
V MVIdmdx, Mdmdytt, MWXJWHfclJt 

[0075] *»K»tB-er4, m®wm^&2 

dx. Mdmdyi:tt:|fc+-5«rtagf^«tt, P#yhR©M» 

[0 0 7 6] J63F»7©ttK/»»o«jE*J:J:or 
L * -5 r £ jfls -TtB 4 ttflt^SEA^e— Mdmd 
x, Mdmdytt, &¥«7<0«tt*JCj:or. -JKi-li*r 
ft-CTb©*— > VhMdmdx, Mdmdy&fr^&Sfc*^ $ 
blC, &ffi{R±fiZ&:?j*:—* > MVIdmdx, Mdmdy^tC# 

[0077] fttc, *&xmm<Dmfc<orm^ mz s m 

Ee«WWf^S:2 7lcJ:oTp^y hRi«(EflL*5* 

[0 0 7 8] mT5$^ii 9 . ^|2*»j!0.31SB 1 3 (0 3 
MR) <oC«2H]Wf^a2 7ii, »«1HIW2 5^& 

u^^^fy i s ©»**©*3HU[ASBf«iuaT 

PMSIl 1 0fff»££<ttH*Nftfttt 3 6 ^ 

> hMdmdxXllMdmdy^S^ 



7 (03»*ttj8i-#J6U^3EII[J: H*#< ^otl^ 
icte, hRiS(B9JL*3 4«lB-e*>-5fc«»fL, 

«TEC« : 5 t aUi*«r»E«iff«ffi£iSA^a2 8 £ asK* 
hWJiSill »L<I1#«4*B3 0) ^ ic^^i 

So 

[0079] r<7>££, p y bmmmmm 1 1 

i^3 0(l WfEBl6X«:H7I^L^J:5i-p^iy 
hR^JBS:^sac>-cttn#!y hRO±ft (Pf*2) <7>fi 

mbm^ssbi i w*»om«L^j:3 4*jai«.a 

[0 0 8 0] ^ hRtol'bdSTdsg, * 

Tt>, p#s> hR#XtfS*»k fcsvMa«^«eo»# 

fc» 6W*Mfr*»2 7rt\ i»i*©J:5^*#rDzK5; h 
R^«E«L^3 4tt»-efc5^WWf-t"6^:«>, ^o*JW 
5:W«*(-ff 3 r £H>Th£. JbfE£><fc 3 tcptf 

s> hR<&m^*Tif*ftf££tt***^ ^>^-CfT3r 

[0081] ^MSti3<oi^iai^f 
»Eitfa2 9 -So 

[0 0 8 2] i^. *IBB6«tt-ett, ±E«>J:3ft»a«: 

Si 2tt^tt-€ t tLPsKy hR^^TibP3>&r>*"5ji&^B4 0 
ibf^^r^ih S *5 J: 3 tdJWT ^^^^-^ 5 &tfl&5T ^ 

[0 0 8 3] KJL<£l§<g\ ^SfiS»¥^2 5 255 

1&T Lft»^\z ±tZ<D «fc3fcn#s>NR ^Sif^^tT 3 C 

[0 0 8 4] osKy hRiS-t^m^^rTrfS 

<fc 31-Sjf^-r^r tX\ D4?y hR^S^yU^— i5 

^ 5 5r*j«i--5aft^~^ 1 8<£>3 ^^V^<o^li, p 

tit, -t ti, fuET>^2 0^^LT 
^yry l 5Wlzm&£tiZftib, m^-y'rV l 5(c3fe 

m-tzim^-? i 8«n^.> hw^jwsai 1, 
^^^s^a 1 3 *t<DW}{Em.jj t L-tsjB-r* r <h ^r- 

i6o«t 5JCP7J? y hR^(E«l$<oaf*S:aSi-f-<< pzK 
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[0 0 8 5] -eUT, D^^hR^i^if^^^ 
X, hRfd^C^S^iftWcOl^HSrWW-rSr 

[0086] *&m<Dn2<DnmMm&ms&m 

[0 0 8 7] H8«r#lLt, ffi&<>< 

K^yfll 1 5Wt^'>7!i 3 7— <D®jftc£>flftA3: 
BUhi-S^-Y^— K3 8, 3 9;&sffl«$*u rtib^)^ 
^^-K3 8, 3 9^Lt, tulB^mtt^-^ 1 8, 

2 2is»jK^tiT^5 0 w^^jcj: 9. ^mtb 
*1 8, 1 9©H±#«)»tt«/jtt, '<y^y 1 5 
W^7f'j3 7l;|j:«^f, ^>^>i^2 2tc 
Sm$tL^«t 5i:^otv^ a f^yfj 3 7(75 

2(^ ^mmmmxn, mx.&mn.—mm=*^7*^~y-<D 

[0 0 8 8] *7t, ^SliteJgffi-ett* ^s/r!i 1 5 (Dm 

mm;zm&-rz>ttsb\cs< ^ y 1 5«tc«x.fcmia»at 

*aS»2 3&T/«E«ffl»2 4 iH*^ iJ-^jxr-y 
3 7|Ci«ix6a«&^^5/xy 3 7 0#H^JE£t^ 

H 1 3 <Biiir1S»$*Btt^& 2 5(1, WiB<a« «9 SaEtfc 
ffi§§2 3AtMBffi»ai»2 4<7)m^T f -^^^^^^y 

aj^4 i coa3^T f -^d>e>-^^y7 t y 3 7^1^ 

SMElEffi|iM»r¥& 2 7 tt % ^SSK^Ifc 2 5 [c J: D B 
^^tL^^<^/^y 1 sSt^-tf^^T-y 3 7co^&^<£> 



£0 

[0 0 8 9] BJiRW LfcJEil^O«*atJ«tBtt«Jia» 
[0 0 9 HiLtf"*? 

^y 1 5xvt^<yfy 3 i (Dm^com&ft&ifx'fem 
zxT^i&T-tzt. m%%mmB:i 3<^(e«ww^s2 

finite^ 1 <o*lfc»ffi S, 
[0 0 9 1] ^M3(7)P7^^x-^ 

v-^2 2*c#x.e>n, -ena*. -ers&ws^m^^ps-r 

5«fc^— ^ 1 8-^«f1Ei3 3Ky hJW*J»3S«l 1 , 
^ligl 3^i^iLT^^il5 a rjx^cfc 

/<yf y i 5»tw?v<y^y 3 7<&»**;feas*j>fc 

SKA**. »ff«tiaa*¥«2 8KlJ:o-CB#y HRO!) 
»fP*tt7 f -^*E*^a2 9Jc:lS««»4-&S»f^S: 

[0 0 9 2] ^tt, wfl>fc g\ 1 8<D|s3£ 

i&E^tf— K3 8, 3 9l:ioT^y7 

y 1 5 w^^y 3 7^*«$tt*r^^< 

hRcDfi,6*T*f *»fM»* »f^*«ttJ*^«2 8^J: 
-=> -C o tK y h R ©BM»r- * *!Bf*¥a 2 9 ICfEft 

i"^fe^>. /<y"rV 1 5W/<yfy 3 7 

jjot, «rE0&*«*w*^yT-y i 
?\z-tz-kx, &®±&9;mj3£. utfyhR<Dm& 

*Ti7»»fls*, »fWKttffi;*7«k2 8i:J:oTa# y 
hR<o»f^ttJBx-^«:IEfE¥ia:2 9fcE««»*^:5 

[0093] 3 (ommmmzm 9 

<oi><Dk. —n<D&.&fti&-fzi><Dv&>z<Dx\ 
&K-v^xt*Mi (onmBmtm— (D&mn^RTfmm 
&m\*^xmmzmft-rz. 

[0094] ^mmmmxn, mmmmmmmm: 1 3 
its tteeawKf** 2 7icj:»ib#7 hR^eeiL^ 

HB*«rn*y MWWffll^ai lK-^SM, KTlEnsKy 
KJB*J»3g|tl 2Jct4-x.5J: 5JdLTV^. ^Lt, 

cztfy hmmmms:! iwo#y 2 
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: - ^^i^sgii 3a>e>#;t$>Jxfc£#, 0**1*09 
y hmnai&iK 1 1 mob i (ommmmtmmca 

5 4:»J»U *fc, osK^-hKtHMjkUl 2 
I3\ *^»B4^V Kl 0**i£fa7^oTT*fT*tfc 

[0 0 9 5] «±«aWLfc^^«rt&i«ltBli«fia* 
l <&jS«BJS£R—-C*S. 

[0 0 9 6] *^»S*»S«lB^J:*ttf. B#yhRiS 
J: 5 K*T»IW 3 ^»f^-r-5^, p#jx hR<Z>*r»JB54# 

[0 0 9 7] W % ^-b^L7t#^^T-i^. 

h r 3 fctftffi-efcs t £ 

tt, ttflStfi^^S^^e — * V hMdrndx^KiMdrndyd* 

^£*£ffiT\ gfrtES (1) , (2) "f»a>$V ^ffiKthx, 
Kwx , Kthy, Kwy US lCj:9, atff;/ h 

R tftEfil Up *tttt-C*> 5 *»5^4r J:;fa 

Jfetttt. i»E#ltM«tt£H«U:, cjK^ hR^fSflfli^: 

[0 0 9 8] ME#IMSffl£flrai, o^yhRiS 

£> 6 ^ g * W i c ^ <£> <o & { t: & m Z t £ ^ L 7t 
75s, znXotetim&mz.X^te^atf? Mcov^T* 
*Bffl-*- 5 w t &X # 5 i i fi t *> >5 A,T-&> 9 > 

[0 0 9 9] ffiE*3fefifc««ST-J2, /<77yo8 

^S^J^~^ > hMdmdxXliMdmdy^J^^7^^^ 



b &mm L*r 3 **tt-C*>5 £ W0rT 5 J: 3 tc LT 

[0100] izit. m^mmmtRx^ hR# 
fflr«<ow*JHWo«rE»f^tt^-^*D#y hRici 

li. BEEtt#«tt^lB8*ot^-e*<TtJ:v\ 
[13 1 ] *5S^<0^5 1 ^H^te{c*5tt 5P^»»t3^ 

im3] Bl©B#y h^«^^»**&a3S«o«IBW 

[05] i2i 1 <Dutfy b<omHk&fttif<omsh'<*— 

[H7] Bl©B# 7 h L-e 3 <ctt«-C l Oil»^< 

[09] ^^^macollifijgffiic^oit^B^^ 
(Do 

[^^Ift^] 

^a) ,15, 3 7-^5,ry, cm 

Wl&T?^ , 2 2 ■•oyfyf, 2 

2 8»-nff±««ij*#*, 2 9-iajsm 32 

3E*») % 3 5-±flc»»B«Wi«, 3 8, 3 
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[13 3] 



[0 5] 



FIG. 3 
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[[219] 
FIG. 9 
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FIG. 6 
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